Node / meshcore / MeshCore / files / src / Utils.cpp

Displaying Raw • Download

Tff7b72#Tff7b72include T8b949e"Utils.h"

Tff7b72#Tff7b72include T8b949e<AES.h>

Tff7b72#Tff7b72include T8b949e<SHA256.h>

Tff7b72#Tff7b72ifdef USE_CC310_HW_CRYPTO

Tff7b72#Tff7b72include T8b949e<Adafruit_nRFCrypto.h>

Tff7b72#Tff7b72include T8b949e"nrf_cc310/include/crys_hash.h"

Tff7b72#Tff7b72include T8b949e"nrf_cc310/include/crys_hmac.h"

Tff7b72#Tff7b72include T8b949e"nrf_cc310/include/ssi_aes.h"

Tff7b72#Tff7b72endif

Tff7b72#Tff7b72ifdef ARDUINO

Tff7b72#Tff7b72include T8b949e<Arduino.h>

Tff7b72#Tff7b72endif

Tff7b72namespace T7ee787mesh Tb4b4b4{

Tffa657uint32_t Td2a8ffRNG::nextIntTb4b4b4(Tffa657uint32_t Te6edf3_minTb4b4b4, Tffa657uint32_t Te6edf3_maxTb4b4b4) Tb4b4b4{

Tffa657uint32_t Te6edf3numTb4b4b4;

Te6edf3randomTb4b4b4(Tb4b4b4(Tffa657uint8_t Tff7b72*Tb4b4b4) Tff7b72&Te6edf3numTb4b4b4, Tff7b72sizeofTb4b4b4(Te6edf3numTb4b4b4)Tb4b4b4)Tb4b4b4;

Tff7b72return Tb4b4b4(Te6edf3num Tff7b72% Tb4b4b4(Te6edf3_max Tff7b72- Te6edf3_minTb4b4b4)Tb4b4b4) Tff7b72+ Te6edf3_minTb4b4b4;

Tb4b4b4}

Tffa657void Td2a8ffUtils::sha256Tb4b4b4(Tffa657uint8_t Tff7b72*Te6edf3hashTb4b4b4, Tffa657size_t Te6edf3hash_lenTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3msgTb4b4b4, Tffa657int Te6edf3msg_lenTb4b4b4) Tb4b4b4{

Tff7b72#Tff7b72ifdef USE_CC310_HW_CRYPTO

Tff7b72static Te6edf3CRYS_HASH_Result_t Te6edf3resultTb4b4b4;

Te6edf3CRYS_HASHTb4b4b4(Te6edf3CRYS_HASH_SHA256_modeTb4b4b4, Tb4b4b4(Tffa657uint8_tTff7b72*Tb4b4b4)Te6edf3msgTb4b4b4, Tb4b4b4(Tffa657size_tTb4b4b4)Te6edf3msg_lenTb4b4b4, Te6edf3resultTb4b4b4)Tb4b4b4;

Te6edf3memcpyTb4b4b4(Te6edf3hashTb4b4b4, Te6edf3resultTb4b4b4, Te6edf3hash_lenTb4b4b4)Tb4b4b4;

Tff7b72#Tff7b72else

Te6edf3SHA256 Te6edf3shaTb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3updateTb4b4b4(Te6edf3msgTb4b4b4, Te6edf3msg_lenTb4b4b4)Tb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3finalizeTb4b4b4(Te6edf3hashTb4b4b4, Te6edf3hash_lenTb4b4b4)Tb4b4b4;

Tff7b72#Tff7b72endif

Tb4b4b4}

Tffa657void Td2a8ffUtils::sha256Tb4b4b4(Tffa657uint8_t Tff7b72*Te6edf3hashTb4b4b4, Tffa657size_t Te6edf3hash_lenTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3frag1Tb4b4b4, Tffa657int Te6edf3frag1_lenTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3frag2Tb4b4b4, Tffa657int Te6edf3frag2_lenTb4b4b4) Tb4b4b4{

Tff7b72#Tff7b72ifdef USE_CC310_HW_CRYPTO

Tff7b72static Te6edf3CRYS_HASHUserContext_t Te6edf3ctxTb4b4b4;

Tff7b72static Te6edf3CRYS_HASH_Result_t Te6edf3resultTb4b4b4;

Te6edf3CRYS_HASH_InitTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Te6edf3CRYS_HASH_SHA256_modeTb4b4b4)Tb4b4b4;

Te6edf3CRYS_HASH_UpdateTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Tb4b4b4(Tffa657uint8_tTff7b72*Tb4b4b4)Te6edf3frag1Tb4b4b4, Tb4b4b4(Tffa657size_tTb4b4b4)Te6edf3frag1_lenTb4b4b4)Tb4b4b4;

Te6edf3CRYS_HASH_UpdateTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Tb4b4b4(Tffa657uint8_tTff7b72*Tb4b4b4)Te6edf3frag2Tb4b4b4, Tb4b4b4(Tffa657size_tTb4b4b4)Te6edf3frag2_lenTb4b4b4)Tb4b4b4;

Te6edf3CRYS_HASH_FinishTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Te6edf3resultTb4b4b4)Tb4b4b4;

Te6edf3memcpyTb4b4b4(Te6edf3hashTb4b4b4, Te6edf3resultTb4b4b4, Te6edf3hash_lenTb4b4b4)Tb4b4b4;

Tff7b72#Tff7b72else

Te6edf3SHA256 Te6edf3shaTb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3updateTb4b4b4(Te6edf3frag1Tb4b4b4, Te6edf3frag1_lenTb4b4b4)Tb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3updateTb4b4b4(Te6edf3frag2Tb4b4b4, Te6edf3frag2_lenTb4b4b4)Tb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3finalizeTb4b4b4(Te6edf3hashTb4b4b4, Te6edf3hash_lenTb4b4b4)Tb4b4b4;

Tff7b72#Tff7b72endif

Tb4b4b4}

Tffa657int Td2a8ffUtils::decryptTb4b4b4(Tff7b72const Tffa657uint8_tTff7b72* Te6edf3shared_secretTb4b4b4, Tffa657uint8_tTff7b72* Te6edf3destTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657int Te6edf3src_lenTb4b4b4) Tb4b4b4{

Tff7b72#Tff7b72ifdef USE_CC310_HW_CRYPTO

Tff7b72static Te6edf3SaSiAesUserContext_t Te6edf3ctxTb4b4b4;

Te6edf3SaSiAesUserKeyData_t Te6edf3keyData Tff7b72= Tb4b4b4{ Tb4b4b4(Tffa657uint8_tTff7b72*Tb4b4b4)Te6edf3shared_secretTb4b4b4, Te6edf3CIPHER_KEY_SIZE Tb4b4b4}Tb4b4b4;

Tffa657uint8_tTff7b72* Te6edf3dp Tff7b72= Te6edf3destTb4b4b4;

Tff7b72const Tffa657uint8_tTff7b72* Te6edf3sp Tff7b72= Te6edf3srcTb4b4b4;

Tffa657size_t Te6edf3dummy_out Tff7b72= T79c0ff0Tb4b4b4;

Te6edf3SaSi_AesInitTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Te6edf3SASI_AES_DECRYPTTb4b4b4, Te6edf3SASI_AES_MODE_ECBTb4b4b4, Te6edf3SASI_AES_PADDING_NONETb4b4b4)Tb4b4b4;

Te6edf3SaSi_AesSetKeyTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Te6edf3SASI_AES_USER_KEYTb4b4b4, Tff7b72&Te6edf3keyDataTb4b4b4, Tff7b72sizeofTb4b4b4(Te6edf3keyDataTb4b4b4)Tb4b4b4)Tb4b4b4;

Tff7b72while Tb4b4b4(Te6edf3sp Tff7b72- Te6edf3src Tff7b72< Te6edf3src_lenTb4b4b4) Tb4b4b4{

Te6edf3SaSi_AesBlockTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Tb4b4b4(Tffa657uint8_tTff7b72*Tb4b4b4)Te6edf3spTb4b4b4, T79c0ff16Tb4b4b4, Te6edf3dpTb4b4b4)Tb4b4b4;

Te6edf3dp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4; Te6edf3sp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4;

Tb4b4b4}

Te6edf3SaSi_AesFinishTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, T79c0ff0Tb4b4b4, Tffa657NULLTb4b4b4, T79c0ff0Tb4b4b4, Tffa657NULLTb4b4b4, Tff7b72&Te6edf3dummy_outTb4b4b4)Tb4b4b4;

Te6edf3SaSi_AesFreeTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4)Tb4b4b4;

Tff7b72return Te6edf3sp Tff7b72- Te6edf3srcTb4b4b4;

Tff7b72#Tff7b72else

Te6edf3AES128 Te6edf3aesTb4b4b4;

Tffa657uint8_tTff7b72* Te6edf3dp Tff7b72= Te6edf3destTb4b4b4;

Tff7b72const Tffa657uint8_tTff7b72* Te6edf3sp Tff7b72= Te6edf3srcTb4b4b4;

Te6edf3aesTb4b4b4.Te6edf3setKeyTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3CIPHER_KEY_SIZETb4b4b4)Tb4b4b4;

Tff7b72while Tb4b4b4(Te6edf3sp Tff7b72- Te6edf3src Tff7b72< Te6edf3src_lenTb4b4b4) Tb4b4b4{

Te6edf3aesTb4b4b4.Te6edf3decryptBlockTb4b4b4(Te6edf3dpTb4b4b4, Te6edf3spTb4b4b4)Tb4b4b4;

Te6edf3dp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4; Te6edf3sp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4;

Tb4b4b4}

Tff7b72return Te6edf3sp Tff7b72- Te6edf3srcTb4b4b4; T8b949e// will always be multiple of 16

Tff7b72#Tff7b72endif

Tb4b4b4}

Tffa657int Td2a8ffUtils::encryptTb4b4b4(Tff7b72const Tffa657uint8_tTff7b72* Te6edf3shared_secretTb4b4b4, Tffa657uint8_tTff7b72* Te6edf3destTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657int Te6edf3src_lenTb4b4b4) Tb4b4b4{

Tff7b72#Tff7b72ifdef USE_CC310_HW_CRYPTO

Tff7b72static Te6edf3SaSiAesUserContext_t Te6edf3ctxTb4b4b4;

Te6edf3SaSiAesUserKeyData_t Te6edf3keyData Tff7b72= Tb4b4b4{ Tb4b4b4(Tffa657uint8_tTff7b72*Tb4b4b4)Te6edf3shared_secretTb4b4b4, Te6edf3CIPHER_KEY_SIZE Tb4b4b4}Tb4b4b4;

Tffa657uint8_tTff7b72* Te6edf3dp Tff7b72= Te6edf3destTb4b4b4;

Tffa657size_t Te6edf3dummy_out Tff7b72= T79c0ff0Tb4b4b4;

Te6edf3SaSi_AesInitTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Te6edf3SASI_AES_ENCRYPTTb4b4b4, Te6edf3SASI_AES_MODE_ECBTb4b4b4, Te6edf3SASI_AES_PADDING_NONETb4b4b4)Tb4b4b4;

Te6edf3SaSi_AesSetKeyTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Te6edf3SASI_AES_USER_KEYTb4b4b4, Tff7b72&Te6edf3keyDataTb4b4b4, Tff7b72sizeofTb4b4b4(Te6edf3keyDataTb4b4b4)Tb4b4b4)Tb4b4b4;

Tff7b72while Tb4b4b4(Te6edf3src_len Tff7b72>Tff7b72= T79c0ff16Tb4b4b4) Tb4b4b4{

Te6edf3SaSi_AesBlockTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Tb4b4b4(Tffa657uint8_tTff7b72*Tb4b4b4)Te6edf3srcTb4b4b4, T79c0ff16Tb4b4b4, Te6edf3dpTb4b4b4)Tb4b4b4;

Te6edf3dp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4; Te6edf3src Tff7b72+Tff7b72= T79c0ff16Tb4b4b4; Te6edf3src_len Tff7b72-Tff7b72= T79c0ff16Tb4b4b4;

Tb4b4b4}

Tff7b72if Tb4b4b4(Te6edf3src_len Tff7b72> T79c0ff0Tb4b4b4) Tb4b4b4{ T8b949e// remaining partial block — zero-pad to 16 bytes

Tffa657uint8_t Te6edf3tmpTb4b4b4[T79c0ff16Tb4b4b4] Tff7b72= Tb4b4b4{Tb4b4b4}Tb4b4b4;

Te6edf3memcpyTb4b4b4(Te6edf3tmpTb4b4b4, Te6edf3srcTb4b4b4, Te6edf3src_lenTb4b4b4)Tb4b4b4;

Te6edf3SaSi_AesBlockTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, Te6edf3tmpTb4b4b4, T79c0ff16Tb4b4b4, Te6edf3dpTb4b4b4)Tb4b4b4;

Te6edf3dp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4;

Tb4b4b4}

Te6edf3SaSi_AesFinishTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4, T79c0ff0Tb4b4b4, Tffa657NULLTb4b4b4, T79c0ff0Tb4b4b4, Tffa657NULLTb4b4b4, Tff7b72&Te6edf3dummy_outTb4b4b4)Tb4b4b4;

Te6edf3SaSi_AesFreeTb4b4b4(Tff7b72&Te6edf3ctxTb4b4b4)Tb4b4b4;

Tff7b72return Te6edf3dp Tff7b72- Te6edf3destTb4b4b4;

Tff7b72#Tff7b72else

Te6edf3AES128 Te6edf3aesTb4b4b4;

Tffa657uint8_tTff7b72* Te6edf3dp Tff7b72= Te6edf3destTb4b4b4;

Te6edf3aesTb4b4b4.Te6edf3setKeyTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3CIPHER_KEY_SIZETb4b4b4)Tb4b4b4;

Tff7b72while Tb4b4b4(Te6edf3src_len Tff7b72>Tff7b72= T79c0ff16Tb4b4b4) Tb4b4b4{

Te6edf3aesTb4b4b4.Te6edf3encryptBlockTb4b4b4(Te6edf3dpTb4b4b4, Te6edf3srcTb4b4b4)Tb4b4b4;

Te6edf3dp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4; Te6edf3src Tff7b72+Tff7b72= T79c0ff16Tb4b4b4; Te6edf3src_len Tff7b72-Tff7b72= T79c0ff16Tb4b4b4;

Tb4b4b4}

Tff7b72if Tb4b4b4(Te6edf3src_len Tff7b72> T79c0ff0Tb4b4b4) Tb4b4b4{ T8b949e// remaining partial block

Tffa657uint8_t Te6edf3tmpTb4b4b4[T79c0ff16Tb4b4b4]Tb4b4b4;

Te6edf3memsetTb4b4b4(Te6edf3tmpTb4b4b4, T79c0ff0Tb4b4b4, T79c0ff16Tb4b4b4)Tb4b4b4;

Te6edf3memcpyTb4b4b4(Te6edf3tmpTb4b4b4, Te6edf3srcTb4b4b4, Te6edf3src_lenTb4b4b4)Tb4b4b4;

Te6edf3aesTb4b4b4.Te6edf3encryptBlockTb4b4b4(Te6edf3dpTb4b4b4, Te6edf3tmpTb4b4b4)Tb4b4b4;

Te6edf3dp Tff7b72+Tff7b72= T79c0ff16Tb4b4b4;

Tb4b4b4}

Tff7b72return Te6edf3dp Tff7b72- Te6edf3destTb4b4b4; T8b949e// will always be multiple of 16

Tff7b72#Tff7b72endif

Tb4b4b4}

Tffa657int Td2a8ffUtils::encryptThenMACTb4b4b4(Tff7b72const Tffa657uint8_tTff7b72* Te6edf3shared_secretTb4b4b4, Tffa657uint8_tTff7b72* Te6edf3destTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657int Te6edf3src_lenTb4b4b4) Tb4b4b4{

Tffa657int Te6edf3enc_len Tff7b72= Te6edf3encryptTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3dest Tff7b72+ Te6edf3CIPHER_MAC_SIZETb4b4b4, Te6edf3srcTb4b4b4, Te6edf3src_lenTb4b4b4)Tb4b4b4;

Tff7b72#Tff7b72ifdef USE_CC310_HW_CRYPTO

Tff7b72static Te6edf3CRYS_HMACUserContext_t Te6edf3hmac_ctxTb4b4b4;

Tff7b72static Te6edf3CRYS_HASH_Result_t Te6edf3hmac_resultTb4b4b4;

Te6edf3CRYS_HMAC_InitTb4b4b4(Tff7b72&Te6edf3hmac_ctxTb4b4b4, Te6edf3CRYS_HASH_SHA256_modeTb4b4b4, Tb4b4b4(Tffa657uint8_tTff7b72*Tb4b4b4)Te6edf3shared_secretTb4b4b4, Te6edf3PUB_KEY_SIZETb4b4b4)Tb4b4b4;

Te6edf3CRYS_HMAC_UpdateTb4b4b4(Tff7b72&Te6edf3hmac_ctxTb4b4b4, Te6edf3dest Tff7b72+ Te6edf3CIPHER_MAC_SIZETb4b4b4, Te6edf3enc_lenTb4b4b4)Tb4b4b4;

Te6edf3CRYS_HMAC_FinishTb4b4b4(Tff7b72&Te6edf3hmac_ctxTb4b4b4, Te6edf3hmac_resultTb4b4b4)Tb4b4b4;

Te6edf3memcpyTb4b4b4(Te6edf3destTb4b4b4, Te6edf3hmac_resultTb4b4b4, Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;

Tff7b72#Tff7b72else

Te6edf3SHA256 Te6edf3shaTb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3resetHMACTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3PUB_KEY_SIZETb4b4b4)Tb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3updateTb4b4b4(Te6edf3dest Tff7b72+ Te6edf3CIPHER_MAC_SIZETb4b4b4, Te6edf3enc_lenTb4b4b4)Tb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3finalizeHMACTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3PUB_KEY_SIZETb4b4b4, Te6edf3destTb4b4b4, Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;

Tff7b72#Tff7b72endif

Tff7b72return Te6edf3CIPHER_MAC_SIZE Tff7b72+ Te6edf3enc_lenTb4b4b4;

Tb4b4b4}

Tffa657int Td2a8ffUtils::MACThenDecryptTb4b4b4(Tff7b72const Tffa657uint8_tTff7b72* Te6edf3shared_secretTb4b4b4, Tffa657uint8_tTff7b72* Te6edf3destTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657int Te6edf3src_lenTb4b4b4) Tb4b4b4{

Tff7b72if Tb4b4b4(Te6edf3src_len Tff7b72<Tff7b72= Te6edf3CIPHER_MAC_SIZETb4b4b4) Tff7b72return T79c0ff0Tb4b4b4; T8b949e// invalid src bytes

Tffa657uint8_t Te6edf3hmacTb4b4b4[Te6edf3CIPHER_MAC_SIZETb4b4b4]Tb4b4b4;

Tff7b72#Tff7b72ifdef USE_CC310_HW_CRYPTO

Tb4b4b4{

Tff7b72static Te6edf3CRYS_HMACUserContext_t Te6edf3hmac_ctxTb4b4b4;

Tff7b72static Te6edf3CRYS_HASH_Result_t Te6edf3hmac_resultTb4b4b4;

Te6edf3CRYS_HMAC_InitTb4b4b4(Tff7b72&Te6edf3hmac_ctxTb4b4b4, Te6edf3CRYS_HASH_SHA256_modeTb4b4b4, Tb4b4b4(Tffa657uint8_tTff7b72*Tb4b4b4)Te6edf3shared_secretTb4b4b4, Te6edf3PUB_KEY_SIZETb4b4b4)Tb4b4b4;

Te6edf3CRYS_HMAC_UpdateTb4b4b4(Tff7b72&Te6edf3hmac_ctxTb4b4b4, Tb4b4b4(Tffa657uint8_tTff7b72*Tb4b4b4)Tb4b4b4(Te6edf3src Tff7b72+ Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4, Te6edf3src_len Tff7b72- Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;

Te6edf3CRYS_HMAC_FinishTb4b4b4(Tff7b72&Te6edf3hmac_ctxTb4b4b4, Te6edf3hmac_resultTb4b4b4)Tb4b4b4;

Te6edf3memcpyTb4b4b4(Te6edf3hmacTb4b4b4, Te6edf3hmac_resultTb4b4b4, Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;

Tb4b4b4}

Tff7b72#Tff7b72else

Tb4b4b4{

Te6edf3SHA256 Te6edf3shaTb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3resetHMACTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3PUB_KEY_SIZETb4b4b4)Tb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3updateTb4b4b4(Te6edf3src Tff7b72+ Te6edf3CIPHER_MAC_SIZETb4b4b4, Te6edf3src_len Tff7b72- Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;

Te6edf3shaTb4b4b4.Te6edf3finalizeHMACTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3PUB_KEY_SIZETb4b4b4, Te6edf3hmacTb4b4b4, Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;

Tb4b4b4}

Tff7b72#Tff7b72endif

Tff7b72if Tb4b4b4(Te6edf3memcmpTb4b4b4(Te6edf3hmacTb4b4b4, Te6edf3srcTb4b4b4, Te6edf3CIPHER_MAC_SIZETb4b4b4) Tff7b72=Tff7b72= T79c0ff0Tb4b4b4) Tb4b4b4{

Tff7b72return Te6edf3decryptTb4b4b4(Te6edf3shared_secretTb4b4b4, Te6edf3destTb4b4b4, Te6edf3src Tff7b72+ Te6edf3CIPHER_MAC_SIZETb4b4b4, Te6edf3src_len Tff7b72- Te6edf3CIPHER_MAC_SIZETb4b4b4)Tb4b4b4;

Tb4b4b4}

Tff7b72return T79c0ff0Tb4b4b4; T8b949e// invalid HMAC

Tb4b4b4}

Tff7b72static Tff7b72const Tffa657char Te6edf3hex_charsTb4b4b4[Tb4b4b4] Tff7b72= Ta5d6ff"Ta5d6ff0123456789ABCDEFTa5d6ff"Tb4b4b4;

Tffa657void Td2a8ffUtils::toHexTb4b4b4(Tffa657charTff7b72* Te6edf3destTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657size_t Te6edf3lenTb4b4b4) Tb4b4b4{

Tff7b72while Tb4b4b4(Te6edf3len Tff7b72> T79c0ff0Tb4b4b4) Tb4b4b4{

Tffa657uint8_t Te6edf3b Tff7b72= Tff7b72*Te6edf3srcTff7b72+Tff7b72+Tb4b4b4;

Tff7b72*Te6edf3destTff7b72+Tff7b72+ Tff7b72= Te6edf3hex_charsTb4b4b4[Te6edf3b Tff7b72>Tff7b72> T79c0ff4Tb4b4b4]Tb4b4b4;

Tff7b72*Te6edf3destTff7b72+Tff7b72+ Tff7b72= Te6edf3hex_charsTb4b4b4[Te6edf3b Tff7b72& T79c0ff0x0FTb4b4b4]Tb4b4b4;

Te6edf3lenTff7b72-Tff7b72-Tb4b4b4;

Tb4b4b4}

Tff7b72*Te6edf3dest Tff7b72= T79c0ff0Tb4b4b4;

Tb4b4b4}

Tffa657void Td2a8ffUtils::printHexTb4b4b4(Te6edf3StreamTff7b72& Te6edf3sTb4b4b4, Tff7b72const Tffa657uint8_tTff7b72* Te6edf3srcTb4b4b4, Tffa657size_t Te6edf3lenTb4b4b4) Tb4b4b4{

Tff7b72while Tb4b4b4(Te6edf3len Tff7b72> T79c0ff0Tb4b4b4) Tb4b4b4{

Tffa657uint8_t Te6edf3b Tff7b72= Tff7b72*Te6edf3srcTff7b72+Tff7b72+Tb4b4b4;

Te6edf3sTb4b4b4.Te6edf3printTb4b4b4(Te6edf3hex_charsTb4b4b4[Te6edf3b Tff7b72>Tff7b72> T79c0ff4Tb4b4b4]Tb4b4b4)Tb4b4b4;

Te6edf3sTb4b4b4.Te6edf3printTb4b4b4(Te6edf3hex_charsTb4b4b4[Te6edf3b Tff7b72& T79c0ff0x0FTb4b4b4]Tb4b4b4)Tb4b4b4;

Te6edf3lenTff7b72-Tff7b72-Tb4b4b4;

Tb4b4b4}

Tb4b4b4}

Tff7b72static Tffa657uint8_t Td2a8ffhexValTb4b4b4(Tffa657char Te6edf3cTb4b4b4) Tb4b4b4{

Tff7b72if Tb4b4b4(Te6edf3c Tff7b72>Tff7b72= Ta5d6ff'Ta5d6ffATa5d6ff' Tff7b72&Tff7b72& Te6edf3c Tff7b72<Tff7b72= Ta5d6ff'Ta5d6ffFTa5d6ff'Tb4b4b4) Tff7b72return Te6edf3c Tff7b72- Ta5d6ff'Ta5d6ffATa5d6ff' Tff7b72+ T79c0ff10Tb4b4b4;

Tff7b72if Tb4b4b4(Te6edf3c Tff7b72>Tff7b72= Ta5d6ff'Ta5d6ffaTa5d6ff' Tff7b72&Tff7b72& Te6edf3c Tff7b72<Tff7b72= Ta5d6ff'Ta5d6fffTa5d6ff'Tb4b4b4) Tff7b72return Te6edf3c Tff7b72- Ta5d6ff'Ta5d6ffaTa5d6ff' Tff7b72+ T79c0ff10Tb4b4b4;

Tff7b72if Tb4b4b4(Te6edf3c Tff7b72>Tff7b72= Ta5d6ff'Ta5d6ff0Ta5d6ff' Tff7b72&Tff7b72& Te6edf3c Tff7b72<Tff7b72= Ta5d6ff'Ta5d6ff9Ta5d6ff'Tb4b4b4) Tff7b72return Te6edf3c Tff7b72- Ta5d6ff'Ta5d6ff0Ta5d6ff'Tb4b4b4;

Tff7b72return T79c0ff0Tb4b4b4;

Tb4b4b4}

Tffa657bool Td2a8ffUtils::isHexCharTb4b4b4(Tffa657char Te6edf3cTb4b4b4) Tb4b4b4{

Tff7b72return Te6edf3c Tff7b72=Tff7b72= Ta5d6ff'Ta5d6ff0Ta5d6ff' Tff7b72|Tff7b72| Te6edf3hexValTb4b4b4(Te6edf3cTb4b4b4) Tff7b72> T79c0ff0Tb4b4b4;

Tb4b4b4}

Tffa657bool Td2a8ffUtils::fromHexTb4b4b4(Tffa657uint8_tTff7b72* Te6edf3destTb4b4b4, Tffa657int Te6edf3dest_sizeTb4b4b4, Tff7b72const Tffa657char Tff7b72*Te6edf3src_hexTb4b4b4) Tb4b4b4{

Tffa657int Te6edf3len Tff7b72= Te6edf3strlenTb4b4b4(Te6edf3src_hexTb4b4b4)Tb4b4b4;

Tff7b72if Tb4b4b4(Te6edf3len Tff7b72!Tff7b72= Te6edf3dest_sizeTff7b72*T79c0ff2Tb4b4b4) Tff7b72return Tffa657falseTb4b4b4; T8b949e// incorrect length

Tffa657uint8_tTff7b72* Te6edf3dp Tff7b72= Te6edf3destTb4b4b4;

Tff7b72while Tb4b4b4(Te6edf3dp Tff7b72- Te6edf3dest Tff7b72< Te6edf3dest_sizeTb4b4b4) Tb4b4b4{

Tffa657char Te6edf3ch Tff7b72= Tff7b72*Te6edf3src_hexTff7b72+Tff7b72+Tb4b4b4;

Tffa657char Te6edf3cl Tff7b72= Tff7b72*Te6edf3src_hexTff7b72+Tff7b72+Tb4b4b4;

Tff7b72*Te6edf3dpTff7b72+Tff7b72+ Tff7b72= Tb4b4b4(Te6edf3hexValTb4b4b4(Te6edf3chTb4b4b4) Tff7b72<Tff7b72< T79c0ff4Tb4b4b4) Tff7b72| Te6edf3hexValTb4b4b4(Te6edf3clTb4b4b4)Tb4b4b4;

Tb4b4b4}

Tff7b72return Tffa657trueTb4b4b4;

Tb4b4b4}

Tffa657int Td2a8ffUtils::parseTextPartsTb4b4b4(Tffa657charTff7b72* Te6edf3textTb4b4b4, Tff7b72const Tffa657charTff7b72* Te6edf3partsTb4b4b4[Tb4b4b4]Tb4b4b4, Tffa657int Te6edf3max_numTb4b4b4, Tffa657char Te6edf3separatorTb4b4b4) Tb4b4b4{

Tffa657int Te6edf3num Tff7b72= T79c0ff0Tb4b4b4;

Tffa657charTff7b72* Te6edf3sp Tff7b72= Te6edf3textTb4b4b4;

Tff7b72while Tb4b4b4(Tff7b72*Te6edf3sp Tff7b72&Tff7b72& Te6edf3num Tff7b72< Te6edf3max_numTb4b4b4) Tb4b4b4{

Te6edf3partsTb4b4b4[Te6edf3numTff7b72+Tff7b72+Tb4b4b4] Tff7b72= Te6edf3spTb4b4b4;

Tff7b72while Tb4b4b4(Tff7b72*Te6edf3sp Tff7b72&Tff7b72& Tff7b72*Te6edf3sp Tff7b72!Tff7b72= Te6edf3separatorTb4b4b4) Te6edf3spTff7b72+Tff7b72+Tb4b4b4;

Tff7b72if Tb4b4b4(Tff7b72*Te6edf3spTb4b4b4) Tb4b4b4{

Tff7b72*Te6edf3spTff7b72+Tff7b72+ Tff7b72= T79c0ff0Tb4b4b4; T8b949e// replace the seperator with a null, and skip past it

Tb4b4b4}

Tb4b4b4}

T8b949e// if we hit the maximum parts, make sure LAST entry does NOT have separator

Tff7b72while Tb4b4b4(Tff7b72*Te6edf3sp Tff7b72&Tff7b72& Tff7b72*Te6edf3sp Tff7b72!Tff7b72= Te6edf3separatorTb4b4b4) Te6edf3spTff7b72+Tff7b72+Tb4b4b4;

Tff7b72if Tb4b4b4(Tff7b72*Te6edf3spTb4b4b4) Tb4b4b4{

Tff7b72*Te6edf3sp Tff7b72= T79c0ff0Tb4b4b4; T8b949e// replace the separator with null

Tb4b4b4}

Tff7b72return Te6edf3numTb4b4b4;

Tb4b4b4}

Tb4b4b4}